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Die f olgendan Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

Prufungsantrag genn. § 44 PatG ist gestellt 

(3) Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters 

(g) Die vorliegnde Erfindung schafft ein Verfahren zum Er- 
fassen und Kompensieren von kinematischen Verande- 
rungen eines Roboters (10) aufgrund interner und/oder 
externer Einflusse mit den Schritten: Bereitstellen eines 
Robotermodells in Form eines technischen Algorithmus 
mit einem oder mehreren festgelegten Paramtern, wel- 
che dietheoretische raumliche Stellung des Roboters (10) 
in Abhangigkeit von einer oder mehreren Steuergro^en 
beschreibt; Steuern der theoretischen raumlichen Soil- 
stellung des Roboters mit einer Robotersteuerung (100) 
gemafS dem Robotermodell; Erfassen der tatsachllchen 
raumlichen Iststellung des Roboters (10) im Betrieb durch 
eine Sensoreinrichtung (Ki, K2; 50); Erfassen der kinema- 
tischen Veranderungen anhand der Abweichung der er- 
fafSten tatsachllchen raumlichen Iststellung des Roboters 
■ (10) von der theoretischen raumlichen Sollstellung des 
g Roboters (10); Anpassen des oder der Parameter des Ro- 
C botermodells zum Kompensieren der kinematischen Ver- 
anderungen unter Berucksichtigung der erfal^ten Abwei- 
chung; und Steuern der theoretischen raumlichen Soll- 
stellung des Roboters mit der Robotersteuerung (100) ge- 
mal^ dem Robotermodell mit dem oder den angepaf^ten 
Para mete rn. 
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Beschreibung 

Die vorlicgcndc Erfindung bclriffl cin Vcrfahrcn zuiri Erfasscn und Koinpcnsiercn von kinciiiatischcn Vcrandcrungcn 
eines Robolers aufgrund intemer und/oder extemerEinfliisse. 
5 Solche kinematischen Verandenmgen beeinflussen insbesondere die Posilionierbarkeit des Roboters und riihren von 
internen EinfluBfaktoren, wie z. B. Alterung, VerschleiB, Derforniation, . . und externen Faktoren, wie z. B. Tenipera- 
tur, Druck, Lastwcchscl, . . ., her. 

Obwohl auf beliebige Roboter anwendbar, werden die vorliegende Erfindung sowie die ihr zugrundeliegende Proble- 
malik in bezug auf einen Indus trieroboter zur Vermessung von Falirzeug-Karosserieteilen erlautert, 
10 Allgeniein koinirien fur die Veniiessung von Bauleilen, insbesondere Fahrzeug-Karosserieleilen in der Auloinobilin- 
dustrie, zunehmend Industrieroboter zum Einsatz. Diese Roboter sind mit einenn beispielsweise optischen MeBsystem 
ausgestattet und konnen sehr flexibel fur komplizierte MeBaufgaben, insbesondere an schwer zuganglichen Stellen ein- 
gesetzt werden. Fur eine gleichbleibend gute Qualitat solcher Messungen ist es erforderlich, daB die kinematischen \fer- 
iinderungen des Roboters kcinen oder nur einen verschwindend geringen EinfluB auf die Messungen haben. 
15 Der Idealzustand ware, wenn sowohi innere Effekte, wie z. B. Abnutzungserscheinungen, als auch auBere Effekte, wie 
z. B. Temperaturschwankungen der MeBumgebung, kompensierbar waren. 

Dies ist jedoch bei den heutzutage bekannten Systemen nicht moglich. Vielmehr ist man darauf angewiesen, die Ab- 
nutzungserscheinungen, Temperatureinflusse usw. direkt zu erfassen und zu kompensieren. Beispielsweise sind somit 
eine haufige Nachjustage der Mechanik des Roboters und eine Klimatisierung der MeBumgebung notwendig. Diese ^for- 
20 gehensweise ist Zeit- und kostenaufwendig. 

Die DE 196 16 276 Al beschreibt ein Verfahren und eine Vorrichtung zum Verniessen und Kalibrieren eines mehrach- 
sigen Industrieroboters mit einer Vermessungseinrichtung, welche aus einem MaBkorper und einer MeBvorrichtung be- 
steht. Der MaBkorper und der Roboter haben einen gemeinsamen Bezugsort, an dem sie losbar und austauschbar ange- 
ordnet sind. An diesem Bezugsort wird zunachst der MaBkorper vennessen, anschlieBend gegen den Roboter ausge- 
25 tauscht und an der Roboterhand befestigt. Der Roboter wird in eine Grundposition mit angenommener NuUstellung sei- 
ner Achsen bewegt, dort vermessen und anschlieBend in eine vorgegebene MeBposition gef ahren, in der der MaBkorper 
emeut vermessen wird. AnschlieBend werden die Istlage des MaBkorpers in der MeBposition und seine Soilage veigli- 
chen, wobei aus den Lageabweichungen die Stellungsdifferenzen zwischen angenommener und tatsachlicher NuUstel- 
lung des Roboters ermittelt werden. Unter Berucksichtigung der Stellungsdifferenzen wird dann der Roboter in die tat- 
30 sachliche NuUstellung gefahren und mit seinen Achsen dort kaUbrien. 

Bei diesem bekannten Verfahren wird jedoch nur einmalig die tatsachliche NullsteUung ermittelt, ohne daB die Ein- 
Uusse von kinematischen Veianderungen des betrefifenden Roboters oder seiner Umgebung auf die zugehorige Roboter- 
steuerung beriicksichtigt werden. 

Eine Aufgabe der vorUegenden Erfindung besteht darin, ein verbessertes Verfahren zur Kompensation der Einfliisse 
35 von kinematischen Veranderungen eines Roboters oder seiner Umgebung auf eine zugehorige Robotersteuerung zu 
schafifen, welches solche ungewiinschten EinfLiisse erfassen und kompensieren kann. 

ErfindungsgemaB wird diese Aufgabe durch das in Anspruch 1 angegebene Verfahren gelost. 

Das erfindungsgemaBe Verfahren weist gegeniiber den bekannten Losungsansatzen den \^rteil auf, daB es eine robu- 
ste Methode zur Erfassung und Kompensation von kinematischen Veranderungen Uefert, die unabhangig von den Ursa- 
40 chen der Veranderungen arbeitet. Durch das beschriebene Verfahren wird der Roboter in die Lage versetzi, wahrend sei- 
ner gesamten Lebensdauer in seiner realen Arbeitsumgebung - in einem definierten Arbeitsraum - seine physisch vor- 
gegebene wiederholgenauigkeit zu bewahren. Auftretende Fehlereinfiusse werden durch das erfindungsgem^e \ferfah- 
ren systematisch erfaBt und permanent kompensiert. 

Damit ergeben sich iiberall dort neue Einsatzgebiete des Roboters, wo bisher aufgrund extemer oder intemer Einflusse 
45 die erforderliche langzeitige Positioniergenauigkeit nicht erreicht werden konnte. 

Die der vorliegenden Erfindung zugrundeliegende Idee besteht darin, daB der Roboter bzw. Posen des Roboters im ge- 
samten Arbeitsraum vermessen werden. Die Posen werden abhangig von der AufgabensteUung durch einen technischen 
Algorithmus optimiert beschrieben. Jeder oder bestimmten vorgegebenen Posen (Sollwert) wird beim Betrieb ein Istwert 
zugeordnet. Diese Parchen von Soll/Istdaten dienen als Input fiir eine Prozedur zur Parameteranpassung bzw. -optimie- 
50 rung. Durch die Parameteroptimierung werden die kinematischen Veranderungen kompensiert. 

Die Ergebnisse konnen dauerhaft oder temporar in der Robotersteuerung abgelegt werden, und bei Bedarf konnen die 
erforderlichen Anpassungen untemommen werden. So werden auftretende reale Abweichungen funktional kompensiert 
und das Positioniervermogen trotz sich andemder Randbedingungen bzw. trotz zunehmendem VerschleiB erhalten. 

Die Erfassung der Abweichungen und deren Kompensation im Betrieb heiBt entweder im Realbetrieb oder im Simu- 
55 lationsbetrieb oder bei beiden. 

In den Unteranspruchen finden sich vorteilhafte Weiterbildungen und Verbesserungen des in Anspruch 1 angegebenen 
Verfahrens. 

GemaB einer bevorzugten Weiterbildung erfolgt das Anpassen des oder der Parameter des Robotermodeils zur Kom- 
pensation der kinematischen Veranderungen unter Berucksichtigung der erfaBten Abweichung, wenn die erfaBte Abwei- 
60 chung einen vorbestimmten Wert iiberschreitet. Dies ist jedoch nicht die einzige MogUchkeit, vielmehr konnen z. B. 
auch Trends verfolgt werden und erst nach mehreren Uberschreitungen Anpassungen eingeleitet werden. 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Bereitstellen eines RobotermodeUs in Form eines tech- 
nischen Algorithmus mit einem oder mehreren festgelegten Parametem durch Anbringen eines MaBkorpers an der Ro- 
boterhand; Erfassen der tatsachlichen raumlichcn IststeUung des MaBkorpers durch die Sensoreinrichtung an einer Vicl- 
65 zahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten und durch Festlegen des oder der 
Parameter derart, daB das Robotermodell die raumUche Stellung des Roboters an den Referenzpunkten in Abhangigkeit 
von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

Gem^B einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens eine Kamera verwendet, 
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welche extern aufgestellt i 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens ein Lageerfassungssen- 
sor vcrwendct wird, wclchcr an dcr RoboLcrhand angcbrachl isl. 

GemaB einer weiteren bevorzugten Weiterbildung wird das Erfassen der kinematischen Veranderungen anhand der 
Abweichung der erfaBten tatsachlichen raumlichen Islstellung des Roboters von der theoretischen raumlichen SoUstel- 5 
lung des Roboters an den Referenzpunkten durchgefuhrt, indeni ein jeweiliger Korrekturvektoren zwischen der erfaBten 
tatsachlichen raumlichen Iststcllung des Roboters und dcm cnlsprcchcndcn Rcfcrcnzpunkl cingefuhn wird. 

GemaB einer weiteren bevorzugten Weiterbildung wird die tatsachlichen raumliche Iststellung des Roboters im Be- 
trieb durch die Sensoreinrichtung mittels eines am Roboter angebrachten MaBkorpers ermittelt wird. Durch die Ma6kdr> 
pcrvermcssung werden die Basis und das Tool unabhangig von der eigcnen Kinematik des Roboters geschatzl, und somit to 
gehen auch seine Fehler nicht in die Schatzung ein. 

GemaB einer weiteren bevorzugten Weiterbildung wird die Giite der im Betrieb durch die Sensoreinrichtung erfaBten 
tatsachlichen raumlichen Iststellung des Roboters ermittelt wird und das Anpassen davon abhiingig gemacht wird. Somit 
gehen als Import fur die Parameteranpassung nur giiltige bzw. zuverlassig ennitteltc Daten ein, und AusreiBer sind cli- 
minierbar. 15 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Ermitteln der Giite durch Bereitstellen eines MaBkorpers 
mit Markem am Roboter; Festlegen eines inneren Koordinatensystems auf dem MaBkorper und der entsprechenden Ko- 
ordinaten dcr Marker; Erfassen dcr Koordinaten der Marker im Weltkoordinatensystem durch die Sensoreinrichtung; op- 
limiertes Abbilden der Koordinaten der Marker im inneren Koordinatensystems auf die Koordinaten der Marker im 
Weltkoordinatensystem und durch Ermitteln der Giite anhand des mittleren Fehlers der Abbildung. Diese \brgehens- 20 
weise Uefcrt einc qualitative Aussage Uber die Gutc der MeBdaten. 

Ausfiihrungsbeispiele der Erfindung sind in den Zeichnungen dargestellt und in der nachfolgenden Beschreibung na- 
her erlautert. 

Es zeigen: 

Fig. 1 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfiihrungsform des 25 
erfindungsgemaBen Verfahrens; 

Fig, 2 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfiihrungsform 
des erfindungsgemaBen Verfahrens; und 

Fig. 3 eine Darstellung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur zweiten Aus- 
fiihrungsform des erfindungsgemaBen Verfahrens. 30 

In den Figuren bezeichnen gleiche Bezugszeichen gleiche oder funktionsgleiche Komponenten. 

Fig. 1 zcigt eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfiihrungsfonn 
des erfindungsgemaBen Verfahrens. 

In Fig. 1 bezeichnet Bezugszeichen 10 einen an seinem Einsatzort fest montierten Roboter, 15 einen Roboterarm, 18 
eine (verdecktc) Robotcrhand, 20 einen MaBkorper, R Refercnzpunkte auf dem MaBkorper 20, 50 einen Lageermitt- 35 
lungssensor, welcher mit dem MeBpunkt 55 zusammenwirkt, Kj und K2 eine erste bzw. zweite exteme Kamera, welche 
den MaBkorper in ihrem gemeinsamen Sichtbereich haben, 100 eine Robotersteuerung und 120 einen Hostrechner. Die 
Roboterhand 18 ist zusatzlich niit einem (nicht gezeigte) Werkzeug, z. B. einem Mefivideosensor, bestiickt. Mit diesem 
Systemaufbau ist man prinzipiell in der Lage, einerseits mit dem Roboter 10 Messungen vorzunehmen und andeierseits 
die Position und Orientierung des MaBkorpers 20 zu bestimmen. 40 

In Form eine Steuerprogramms exisdert in der Robotersteuerung ein Robotermodell in Form eines technischen bzw. 
physikalisch/mathemadschen Algorithmus mit einem oder mehreren festgelegten Parametern, welches die theoretische 
raumliche Stellung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt. Als Parameter 
koirunen beispielsweise Linklangen, Achsenschiefstande, NuUpunktfehler, Gelenklose, GelenkelastizitSten usw. in 
Frage. . - 45 

Mittels dieses Modells und einer entsprcchend modifizierten Kinematik ist der Roboter 10 in der Lage, kartesische Po- 
sitionen in seinem Arbeitsraum mit hoher Genauigkeit zu erreichen. 

Im folgenden wird naher erlautert, wie der oder die Parameter fiir das Robotermodell festgelegt werden. Zum Zeit- 
punkt der Inbetriebnahme befindet sich der Roboter 10 in einer bestimmten kinematischen Konfiguration, die von den 
besagten intemen und externen EinfluBfaktoren abhangig ist. Diese Referenzkonfiguration wird iiber eine Referenzmes- 50 
sung festgehalten, indem der MaBkorper 20 an ausreichend vielen raumlichen Roboterstellungen (entsprechend Refe- 
renzpunkten ai mit i = 1 . . . n), welche durch die SteuergroBen bestimmt werden, durch die eine erste und zweite exteme 
Kamera Ki bzw. K2 veniiessen wird. Darauf erfolgt das Festlegen des oder der Parameter derart, daB das Robotermodell 
die raumliche Stellung des Roboters 10 an den Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit ei- 
ner bestimmten sehr hohen Genauigkeit beschreibt. Hoch bedeutet dabei, daB die Genauigkeit groBer ist als die aufgrund 55 
der kinematischen Veranderungen auftretenden Schwankungen. 

Andert sich nun die Referenzkonfiguration, d. h. treten kinematische Veranderungen des Systems auf, werden die Re- 
ferenzpunkte aj nicht mehr mit der sehr hohen Genauigkeit anfahrbar sein, welche durch die Referenzmessungsparame- 
ter bestimmt ist, sondern es werden sich Abweichungen zwischen Soil- und Istwerten ergeben, welche mittels der beiden 
Kameras Ki, K2 und/oder dem Lagesensor 50 erfaBt werden. 60 

Aufgrund der jeweiligen Abweichung zwischen Sollwert Fi, und Istwert F*i wird eine Anpassung des oder der Para- 
meter des Robotermodells ausgelSst, namlich bei dieser Ausfiihrungsform, wenn die erfaBte Abweichung einen vorbe- 
sdmmten Wert iiberschreitet. 

Diese Anpassung geschieht dadurch, daB ein jeweiliger Korrekturvektoren Tj zwischen der erfaBten tatsachlichen 
raumlichen Iststellung F*i des Roboters 10 und dem entsprechenden Referenzpunkt als Sollwert Fj eingefiihrt wird. Es 65 
gilt dabei die fiinktionelle Beziehung: 

T(M,ai) . Ti = Fi (1) 
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wobei die Korrekturvektoren den Fehler T(M, a,)'' Fi zwischen dem Iheoretischen Soll^TCM, ai) und der Referenz- 
messung >i beschreiben, wobei M das urspriingliche Coniputennodell ist. 

Der zentralc Teil der Anpassung bcslchL nun darin, daB urspriingliche RoboteniiodeU M init dein oder den urspninali- 
chen Parametern in ein angepaBtes Robotermodeil M* mil einem oder mehreren angepaBten Paramerern umzuwandeln 

uiese Autgabe tuhrt auf ein nicht-lineares Mininfiierungsproblem der Form: 

n 

2:jT{M*.ai) - Fi* T-M' = min. (2) 
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Die Losung dieses Minimiemngsproblems erfolgt zweckmaBigerweise mittels der Gau6-Newton-Methode 
Durch die Einfuhrung der Korrekturvektoren gelingt es also, die Fehler zu quantisieren und zu kompensieren welche 
auf k.nematischen Anderungen derReferenzkonfiguration beruhen. Dabei werden nicht die EnfluBfaktoren, sondemde- 
ren Wirkung crfaBl. Lelztere sind also unerheblich, da derRoboter 10 lediglich auf scin urspriingliches Verhalten zuriick- 

15 gerutirt vvird. 

Das Steuem der theoretischen raumlichen SollsteUung des Roboters mit der Robotersteuerung (100) gemaB dem Ro- 
botermodeil niit dem oder den angepafiten Parametern erfolgt dann solange, bis die erfaBten Abweichungen eine erneute 
Anpassung erforderlich machen. ^ 

GemaB einer Weiterbildung der ersten Ausfuhrungsform wird nun eine robuste und reproduzierbare Prozedur aneeee- 
20 ben, durch die die Position und die Orientierung eines MaBkorpers bzw. MeB werkzeuges im kartesischen Raum hochee- 
nau ermittelt werden kann. Die Prozedur benotigt neben den MeBwerten ein internes Koordinatensystem, in dem die 
MeBmerkmale a prion bestimmt wurden, als EingangsgroBen. Im weiteren \ferlauf der Prozedur entsteht eine Koordina- 
S^^?h2re™rMeBw^^ ^"""^ MeBwerkzeugskoordinatensystem durch eine optimal© Anpassung 

tJber die bekannten Abstande der MeBmerkmale untereinander wird die Gute der MeBdaten laufend eindeutie kontrol- 
hert, also nicht nur nach ihrer Plausibilitat, sondem genau quantisierbar. Somit konnen AusreiBer der MeBdaten konkret 
der gemessenen Istwerte der raumlichen Position des Roboters 10, eUminiert werden und verhindert werden daB die irr- 
tumiicherweise eine Anpassung des oder der Modellparameter auslosen. 

Im einzelnen besteht der MaBkorper aus einer stabilen Vorrichtung zum Anbringen von MeBmerkmalen (sog. Marker) 
Hierbei sind verschiedene Vanationen von einer Metallplatte bis hin zu einzelnen Verstrebungen vorstellbar Wichtic ist 
aUein die geometrische Invarianz, also Stabilitat gegenuber Verformungen. 

Das interne Koordinatensystem bzw. MeBwerkzeugskoordinatensystem des MaBkorpers entsteht aus einer Messune 
der MeBmerkmale die darauf in ausreichend groBen Abstanden angebracht sind. Diese Messung erfolgt unter optimalen 
Bedmgungen und hefert alle Markerpositionen im intemen Koordinatensystem mit wiUkurach definiertem Ursprung 
w u."'' ^^^^^""S liefert die Position und Orientierung des MaBkorpers, der am Roboter 10 angebracht ist, bezuglich des 
Weltkoordinatensystems, wie z. B. erfaBt durch die extemen Kameras Kt und K^. Die extern erfaBten MeBwerte t bilden 
mit den entsprechenden bekannten Koordinaten xi des intemen Koordinatensystems die Eingangsdaten fur diese Schat- 
zung. Man sucht nun eine Abbildung A bestehend aus einem TVanslationsanteil (a, b, c) und einem Rotationsanteil (a B 
Y), welche jedes Urbild Xi, auf den entsprechenden MeBwert yi abbildet. Dieser Ansatz laBt sich mit der Methode der 
kleinsten Fehlerquadrate losen, namlich gemaB der Beziehung: 
n 

5:^jA{a,b,c;a,p,Y)xi - yij^ = ^ain. o) 

Der mitUere Fehler der Abbildung liefert dann ein MaB fur die gesuchte Gute. 

Fig. 2 zeigt eine schematische Darsteliung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfuhrungs- 
rorm des erfindungsgemSBen Verfahrens. ^ 

In Fig. 2 b^ichnen zusatzUch zu den bereits eingefuhrten Bezugszeichen KC eine KamerasteuerungsZ-auswertung- 
emnchtung, 150 emen MeBvideosensor, 200 ein MeBobjekt in Form einer Fahrzeugkarosserie und PA eine MeBvideo- 
sensorsteuerungsZ-auswertungeinrichtung. ^"viuw 
Der in Fig, 2 gezeigte Systemaufbau dient zur genauen Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideo- 
sensor 150 unter Manipulation durch den Roboter 10. 

Zunachst wurde ein Robotermodeil mit mehreren festgelegten Parametern, welches die theoretische raumliche Stel- 
lung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt, vorgegeben. Es erfolgte dann 
ein Steuern der theoretischen raumhchen SollsteUung des Roboters mit der Robotersteuerung 100 gemaB diesem Robo- 
termodeU und dabei eine Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 

Dann wurde das derart aufgebaute MeBsystem thermischen StreBfahrten mit einem Temperaturhub von 20°C unter- 
worren . 

Es folgte ein Erfassen der tatsachlichen raumlichen Iststellung des Roboters 10 im Simulationsbetrieb durch die Sen- 
soreinnchtung in Form der Kameras K,, K2. Wie erwartet ergabt sich das Vorhandensein kinemaUscher Veranderungen 
als Folge der thermischen StreBfahrten. Es folgte eine erneute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvi- 
deosensor 150 (unkompensierte Daten in Fig. 3). 

Es folgte darauf Anpassen der Parameter des Robotermodells zum Kompensieren der kinemalischen Veranderungen 
unter Berticksichtigung der erfaBten Abweichung und ein Steuern der theoretischen raumlichen SollsteUung des Robo- 
ters mit der Robotersteuerung gemaB dem Robotermodeil mit dem oder den angepaBten Parametern und dabei eine er- 
neute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 (kompensierte Daten in Fig 3) 

Fig. 3 zeigt eine Darsteliung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur zweiten 
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Wie deutlich aus Fig. 3 erkennbar, zeigen die unkonipensierten Daten eine Abweichung von bis zu etwa 0,390 mm ge- 
gcnubcr dcrcrslen Mcssung vor den thcniiischcn SlrcBfahrtcn. Dciiigcgcnubcr zcigcn die konipcnsicrlcn Daten IcdigLich 
eine Abweichung von bis zu etwa 0,125 mm gegeniiberder erslen Messung vor den thermischen StreBfahrten. Die Kom- 
pensation schafft also eine Verbesserung urn einen Faktor 3. 5 

Obwohl die vorliegende Erfindung vorstehend anhand bevorzugter Ausfuhrungsbeispiele beschrieben wurde, ist sie 
darauf nichl bcschrankt, sondem auf viclfaltige Art und Weise inodinzierbar. 

Insbesondere sind genannten Anwendungen nur beispielhaft und beliebig verallgemeinerbar. Auch ist die Positionser- 
fassung nicht auf Kameras beschrankt. Der MaBkorper muB nicht ein selbstandiger Korper sein, sondem kann in den Ro- 
bolcr inlcgriert sein. Auch die genannlen Algorithmcn dienen nur IllusLralionszwcckcn und konnen durch andere geeig- lo 
nete Optimierungsalgorithmen ersetzt werden. 




Bezugszeichenliste 

10 Roboter 15 
100 Robotersteuerung 
50 Sensor 

55 MeBpunkt fur Sensor 50 
15 Roboterarm 

18 Roboterhand 20 
20 MaBkorper 
Ki Kamera 1 
K2 Kamera 2 

KC KamerasteuerungsZ-auswertungeinrichtung 

150 MeBvideosensor 25 

200 MeBobjekt, Fahrzeugkarosserie 

PA MeBvideosensorsteuerungsZ-auswertungeinrichtung 

R Referenzpunkt auf 20 

120 Hostrechner 

30 

Patentanspruche 



1. Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters (10) aufgrund in- 
temer und/oder extemer Binflusse mit den Schritten: 

Bereitstellen eines Robotermodells in Form eines technischen Algorithmus init einem oder inehreren festgelegten 35 
Parametem, welches die theoretische raumliche Stellung des Roboters (10) in Abhangigkeit von einer oder mehre- 
ren SteuergroBen beschreibt; 

Steuem der theoretischen raumlichen Sollstellung des Roboters mit einer Robotersteuerung (100) gemaB dem Ro- 
botermodell; 

Erfassen der tatsachlichen raumlichen Iststellung des Roboters (10) im Betrieb durch eine Sensoreinrichtung (Ki, 40 
K2; 50) 

Erfassen der kinematischen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststel- 
lung des Roboters (10) von der theoretischen raumlichen Sollstellung des Roboters (10); 

Anpassen des oder der Parameter des Robotermodells zum Kompensieren der kinematischen Veranderungen unter 
Beriicksichtigung der erfaBten Abweichung; und 45 
Steuem der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Robo- 
termodell mit dem oder den angepaBten Parametem. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB das Anpassen des oder der Parameter des Robotermo- 
dells zur Kompensation der kinematischen Veranderungen unter Beriicksichtigung der erfaBten Abweichung er- 
folgt, wenn die erfaBte Abweichung einen vorbestimmlen Wert iiberschreitet. 50 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB das Bereitstellen eines Robotermodells in Form 
eines technischen Algorithmus mit einem oder mehreren festgelegten Parametem folgendermaBen erfolgt: 
Anbringen eines MaBkorpers (20) an der Roboterhand (18); 

Erfassen der tatsachlichen raumlichen Iststellung des MaBkorpers (20) durch die Sensoreinrichtung (Ki, K2; 50) an 
einer Vielzahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten; und 55 
Festlegen des oder der Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters (10) an den 
Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 
(Ki, K2; 50) mindestens eine Kamera (Ki, K2) verwendet wird, welche extern aufgestellt ist. 

5. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 60 
(Ki, K2; 50) mindestens ein Lageerfassungssensor (50) verwendet wird, welcher an der Roboterhand (18) ange- 
bracht ist. 

6. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB das Erfassen der kinemati- 
schen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) 
von der theoretischen raumlichen Sollsteliung des Roboters (10) an den Referenzpunkten durchgefuhrt wird, indem 65 
ein jeweiliger Korrekturvektoren zwischen der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) und 
dem entsprechenden Referenzpunkt eingefuhrt wird. 

7. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB die taLsachlichen raumliche 
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Iststellung des Roboters (10) im Betrieb durch die Sensoreinrichtung (Ki, K2; 50) miS^eines am Roboter (10) an- 
gebrachten MaBkorpers (20) enniltell wird. 

8. Vcrfahren nach cinciri dcr vorhcrgcht^ndcn Anspriiche, dadurch gckcnniicichncl, daB die Giilc dcr irn Bctricb 
durch die Sensoreinrichtung (Ki, K2; 50) erfaBten tatsachlichen raumiichen Iststellung des Roboters (10) ermittelt 
wird und das Anpassen davon abhangig gemacht wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeichnel, daB das Ermitteln der Giite folgendermaBen erfolgt: 
Bcreitstcilcn cines MaBkorpers (20) mit Markem (R) am Roboter (10); 

Festlegen eines inneren Koordinatensy stems auf dem MaBkorper und der entsprechenden Koordinaten der Marker 

(R); 

Erlasscn der Koordinaten der Marker (R) iiii WeUkoordinatcnsystem durch die wSensorcinrichtung (Ki, K2; 50); op- 
timiertes Abbilden der Koordinaten der Marker (R) im inneren Koordinatensystfims auf die Koordinaten der Marker 
(R) im Weltkoordinatensystem; und 

Ermitteln der Giite anhand des mittleren Fehlers der Abbildung. 

10. Robotersteuerung (100) zur Durchfuhrung des Vcrfahrcns nach mindestens eineiii der vorhergehenden Ansprii- 
che. 
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